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1.0 INTRODUCTION 

Due to the extensive use of the quaternion in the onboard Space 
Shuttle Computer System, considerable analysis is being performed using 
relationships between the quaternion, the transformation matrix, 
and the Euler angles. This Design Note offers a brief mathematical 
development of the relationships between the Euler angles and the 
. transformation matrix, the quaternion and the transformation 
matrix, and the Euler angles and the quaternion. The analysis 
and equations presented here apply directly to current Space 
Shuttle problems. Appendix A presents the twelve three-axis 
Euler transformation matrices as functions of the Euler angles, 
the equations for the quaternion as a function of the Euler angles, 
and the Euler angles as a function of the transformation matrix 
elements. 

The equations of Appendix A are a valuable reference in Shuttle 
analysis work and this Design Note is the only known document where 
each of the twelve Euler angle to quaternion relationships are 
given. Appendix B presents a group of utility subroutines to 
accomplish the Euler-matrix, quaternion-matrix, and Euler- 
quaternion relationships of Appendix A. 
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2.0 DISCUSSION 

2.1 Euler Anglo Transformation Matrices 

The following analysis and utility subroutines are offered 

to simplify computer programs when working with coordinate 

transformation matrices and their relationships with the 

Euler Angles and the Quaternions. The coordinate transfor- 

« 

mation matrices discussed .here are defined using the following 
figure, 



FIGURE 1 
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The transformation matrix M, is defined to transform vectors 
in the 7- system (x, y, z) into the original x-system (x, y, 
2 ) and is given by the equation, 
x = Mx 

where (!) 

x = (x, y, z) and 7 = (7, y, z). 


Using the right-hand rule for positive rotations, the M matrix 
in (1) above is constructed by the following analysis. The 
first rotation in Figure 1 above is about the x-axis by the 
amount 0 ^. The single rotation about the x-axis results in 
the following transformation, 



or x = Xx' in matrix form. Rotation about the y'-axis by the 
amount 62 yields the intermediate transformation matrix: 



or x 1 = Yx* in matrix form. Finally rotation about the z"-axis 
by the amount 0 3 yields the intermediate transformation matrix. 
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and in matrix form x' 1 = Zx-| . Now using the three equations, 


x * Xx‘ 

x 1 = Yx" (5) 

x" = Zx 

by substitution 

X = (X Y Z) x. (6) 

Then from equation 1, 

M = (X Y Z) (7) 

Computation for the M matrix from the indicated matrix multi- 
plication in equation (7) yields, 


(cos0rj cosOg) {- c.osOg sin9 3 ) • (sin0 2 ) 

M = (cos0-| sine^ + sine-, sine 2 cose 3 ) ('cosQ-j cose 3 - sine^ sine 2 sine 3 )(- ?ine 1 cose 2 ) 

y(sin0-j sin 0 3 - cos0-j sin0 2 cose 3 ) (sinG-j cos0 3 + cose^ sine 2 sin0 3 ) (cos0-j cus0 2 ) 



The matrix M in equation (8) is a function of; 

(1) The three Euler angles 0-| 0 2 and 8 3 and 

(2) The sequence of rotations used to generate the matrix. 

% 

By examination of equation (7) it is possible to show that there 
are twelve possible Euler rotational sequences. If the (X Y Z) 
notation in equation {7} represents a rotation about the X axis, 
then the Y axis and finally the 1 axis, then the following per- 
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mutations o*' the rotational order represents the twelve possible 
Euler angle sets using three rotations, 

X Y Z Y X Z Z X Y 

XZY YZX ZYX 

(9) 

X Y X YXY ZXZ 

XZX YZY ZYZ 

Any repeated axis rotation such as XXY does not represent a 
three axis rotation but reduces to the two axis rotation XY. • 

Hence the rotations described in (9) above represent all 
twelve possible sets of Euler angle defining sequences. Con- 
versely then, for a given transformation matrix there are 
twelve Euler angle sets which can be extracted from the matrix. 

The 'Euler matrices corresponding to all possible rotational 
sequences of (9) above are presented in Appendix A. 

The utility subroutines "EULMAT" generates the transformation 
matrix from a given Euler sequence and the Euler angles. The 
utility subroutine "MATEUL" extracts the Euler angles from a given 
Euler rotational sequence. The convention is established that 
the Euler angles occur in the same sequences as the axis 
rotations. Using this concept and functional notation, equation (7) 
could be expressed as 

M = X Y Z - M(8 x , e y , e z ) (10) 


and from (9) 



DN No. : 1.4 
Page: 6 


M = X Z X - M(0 X , 0 Z , etc. (11) 

This convention is assumed in both subroutines and also 
used throughout this design note when Euler angles are 
used. A brief explanation of the use of these two 
utility subroutines is given in Appendix B. 

It is interesting to note that a negative rotation in 
the single axis rotation matrices of equations (2), (3) 
and (4) will result in the formation of the transpose 
of the matrix. However the transpose of M in equation 
(7) is formed from reversing the order of multiplication 
and transposing the individul axis rotation equations, 
i.e. 

M T = (X Y Z) T = ( Y Z) T X T = Z T Y T X T . 

Hence the transposes of the matrices of (9) are easily 
formed by reversing the order of multiplication and 
transposing each single axis rotation equation.' Using 
the notation in equations(lO) and (11) above equation 
(12) could be written, 

M T (0 x , e y , 0 Z ) = M(-e z , -e y , -e x ). (13) 

* 

It is recommended to avoid confusion that the forward 
transformation be computed and simply transposed to yield 
the reverse transformation matrix. All matrices of Appendix 
A are in the forward form, i.e. X = M’x and formed from (9). 


8-020 
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2.2 TRANSFORMATION MATRICES USING 
THE HAMILTON QUATERNION 


The transformation matrix of equation (!) can be written as 
a function of the Hamilton Quaternion; 


q.j = cos w/2 
q 0 = cos a sin u/2 

2 (14) 

q^ * cos fjsin m/2 

q 4 = cos y sin to/2 s 


where to is the rotation angle about the rotation axis with 

*1 a o 

a, 0, and y direction angles with the x, y and z axes rt- 

' 2 2 2 2 
spectively.. Notice also that + q 2 + q 3 +' q 4 = 1, since 

2 2 2 • 
cos a + cos 0+ cos y = 1 . The rotation angle, to, is assumed 

positive according to the right-hand rule of axis rotation. 

The matrix M becomes 

/ (q-j + ^2 " q 3 q 4^ 2 ^ q 2 q 3 “ q l q 4^ 2 ( q 2 q 4 + q l q 3^ 


M = 


2 ( q 2 q 3 +q l q 4^ ( q l " q 2‘t ?3 -qj) 2{q 3 q 4 - q-jq 2 ) 

\^2(qgq 4 - q^q^) 2(q^q 4 + q-j q 2 ) (q^j “ q 2 ” q 3 + q 4^ 


(15) 


For a more detailed discussion of the derivation of equation 
(15), see Reference 1. Using functional notation, equation 
(15) can be written. 


M = H(q-J > q 2 » q 3 » q 4 ). (16) 

Unlike the Euler angle rotational sequences to describe the 
transformation matrix of equation (1), only two quaternions 
can be found from equation (15). The two quaternions are: 


4-8-020 
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q i "**1 


q 2 

q 3 


and 


~ q 2 

_q 3 


q 4 



07) 


These two quaternions represent a positive rotation about 
the rotation axis pointing in one direction and a positive 
rotation about the same line of rotation pointing in the 
opposite direction. Both quaternions of (17) satisfy equation 
(15). 


Thb utility subroutine "QMAT 11 generates the transformation 
matrix from a given quaternion. The "QMAT" algorithm generates 
the matrix as given in equation (15) without duplicating any 
arithmetic operations. The subroutine "MATQ" extracts the positive 
quaternion, i.e., q-j > 0, from the transformation matrix and 
normalizes the results to guarantee an orthogonal matrix. In 
order to avoid any discontinuity in extracting the quaternion 
from the transformation matrix, the procedure as described in 
Reference 2 is used. 

Early works by Hamilton (Reference 3) presented the quaternion 
as having a scalar and a vector part, i.e., 

= 5 V ~ (q 2 , q^j q 4 ) 

and equation (16) could be expressed as, 

. M = M(q r q 2 , q 3> q 4 ) = M(S, V). 


8-020 


(18) 

09 ) 
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For a given quaternion the following relationship is 
true (from (17) above), 

M(S, V) = M(-S, -V), (20) 

The transpose of the transformation matrix is given by, 
M'(S, V) = M(-S, V) = M(S, -V). (21) 


2.3 EULER ANGLE AND QUATERNION RELATIONSHIPS. 


By examination of equations (10) and (16) the equality, 


M(X( 0 1 ) » Y( 0 2 ), Z(e 3 )) = M(e v 0 2> 0 3 ) = M (q r q 2 , q^, q 4 ) (22) 


can <be written. Based on an equality for each element of the 
matrix the following nine equations must be true; 


2 2 2 2 

cose,, COS 0 3 ? q^ + q 2 - q 3 q 4 

-cos0 2 sin0 3 = 2(q 2 q 3 - q ] q 4 ) 

Sin0 2 = 2(q 2 q 4 + q ] q 3 ) 

COS0-J sin0 3 + sin0-| sin0 2 cosGo = 2(q 2 q 3 + ) 

2 2 2 2 

cos0 1 cos0 3 - sinQ-j sin9 2 sin0 3 - q-j - q 2 + q 3 - q 4 
-Sin0-j cos0 2 = 2(q 3 q 4 - q- ( q 2 ) 
sin6-| sin0 3 - cosG-j sin0 2 cos0 3 = 2 (q 3 q 4 - q 4 q^ ) 

sin0-j cos0 3 + cosG-j sine 2 sin0 3 = 2(q 3 q 4 + q^) 

COS0 1 COS0 2 = q^ - q 2 - q^ 4- % 


(23) 


It is possible to solve for the values of the quaternion using 
the trigonometric half angle identities. For this Euler sequence, 
i.e. X (0-j ) Y (o 2 ) Z (e 3 ), the following quaternion results; 


8-020 
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q-j - “Sin^O^ sintjO,, si n^e 3 + cos%0^ cos)^ coss^ 

q 2 = +sin)i0 1 cos^ 9 2 cosi^ + sin 1 ^ sin^0 3 cos?^ 

(24) 

q 3 = -sin^ sin'20 3 cos%e 2 + sin^0 2 cos’iO-j cos^ 

- +sin- 1 20 1 sin?i0 2 cos^o 3 + sin- 1 ^ cosJzO-j cos- 1 ^ 

Appendix A gives the quaternion as a function of the Euler 
angles for each of the twelve Euler rotational sequence pre- 
sented in Section 2.1. The special equations for the quaternion 
esfunctions of the Euler angles, like equations (24) above, 
are sometimes cumbersome to use, especially when multiple 
Euler sequences are utilized. Less coding, but perhaps more 
computer operations, are required by using the more general 
method of first generating the matrix M from the given Euler 
angle set and then simply extracting the quaternion from the 
matrix. This method is effected by first a call to "EULMAT" 
and then a call to "MATQ".. 
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APPENDIX A 

The twelve Euler matrices for each rotation sequence are given based ■ 
on the single axis rotation equations (2), (3) and (4). The Euler 
matrices transform vectors from the system that has been rotated into 
vectors in the stationary system. Also presented here are the equations 
for the quaternion as a function of the Euler angles and the 1 Euler 
angles as a function of the matrix elements for each rotation sequence. 
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(1) M = M C X { 0 -j ) , Y(0 2 )j 2(G 3 )) = XYZ 
Axis Rotation Sequence: 1, 2, 3 


M 


cos© 2 cos© 3 

sin0-|Sin02Cos02 

+cos0-jSin02 

-cosB^sinGgCosS^. 

+sin0-|Sin0 3 


-cos0 2 sinO 3 sin0 2 

-si n8i r !n0 2 sin6 3 -sin0-|Cos8 2 

+COS0-J COS0 3 

cos6^sin0 2 sin0 3 cus0^c’os0 2 

+sin0^cos0 3 


q l 

q 3 

q 4 


= -sin^0^sin^6 2 sin%0 3 
= sin^0^cos%0 2 cos%0 3 
- -sin%0-jsin^0 3 cos%0 2 
= sini20-|SinJi0 2 cosia0 3 


©1 = tan 



© 2 = tan 


-1 


m 


n 


Vi 


l-m 


13 


+ COS^0^COS?i0' 2 COS%0 3 
+ sinJj0 2 sin%© 3 cosJs0^ . 
+ sin%0 2 cos%0-jCos%© 3 

+ $in%e 3 cos^0.jcos^e 2 
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(2) M * M(X ( 0 -j ) , Z(0£ ) » Y (O 3 ) ) = XZY 
Axis Rotation Sequence: 1, 3, 2 


cosOgCosOg 

cosS^sinO^cosG^ 

+sinQ^sin0 3 

sin0-jSin0 2 cos0 3 
-cose 1 sine^ 


-sin0 2 

COS0^COS0 2 

sin8iCOs6 2 


cosO 2 sin0 3 

cos0-|Sin0 2 sin0 3 

-sin0-jcos0 3 


sin0-jsin02sin0 3 

+co e :0-jcos8 3 


q-j = +sin%9isin ? s02sinis0 3 + cosH6-]Cos^0 2 cos%0 3 

= +sin%eicos%0 2 cos>s8 3 - sin^sin^oos^e-j 

q 3 - -sinJsG-jSin^cos^Sj + sin^cos^G-jCOS 5 ^ 

= +sin% 0 -j 5 in% 9 3 cos ^92 + sin^BgCOsHB-j 005*563 



0 2 = 


tan 


- 1 / 


-m 


12 


Vvir 


nv 


12 


*»--■' ( 5 ) 
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(3) M » M(X(0 1 )» Y(0 2 )» X(0 3 )) = XYX 
Axis Rotation Sequence: 1, 2, 1 




sinQgSine^ 

COSQiCOSQg 

-sinQ-jCOsQgSineg 

+sin0-|COS02 

+ cos0.jcos0 2 sin0 3 


sin0 2 cos0 3 

-cos0-jsin0 3 

-sine-jcos0 2 cos0 

-sinO^sinBg 

+cosO^cos0 2 cos0 



q-| = cos^0 2 cos(%(0-] + 0 3 )) 
q 2 = COS^sinO^B-j + 0 3 )) 
q 3 =■ sin%0 2 cos{Js(0^ - Qg) ) 
q 4 = sinJ 5 0 2 sin{%{0 1 - 0 3 )) 
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(4) M = M ( X ( e-j ) , Z(0 2 ), X(0 3 )) = XZX 
Axis Rotation Sequence: 1, 3, 1 




-sin0 2 cosO 3 

cosO-|Cos0 2 cosO 3 

-sinB.sinBo 
1 3 

sin0^cos0 2 cos0 3 

+cos0^sin0 3 


sin0 2 sin0 3 

-cose^cosBgSine 

-sinQ-jCoseg 

-sirs0.jCos0 2 sin0 

+cos0^cosq 3 



q-j = cos^cos^S-j + e 3 )) 
q 2 ~ cos%0 2 sin(%(0-j + e 3 )J 
q 3 = -sin 1 -30 2 sin(%(0 1 - 0 3 )) 
q 4 = sin%0 2 cos(%(0 1 -0 3 )) 
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(5) M = M(V{G 1 ), X(0 2 ), Z(0 3 )) = YXZ 
Axis Rotation Sequence: 2, 1, 3 


M 


sinO^sinO 2 sin0 3 

+COS0-jCOS0 3 

cosS^sinG^ 

cos0^sin0 2 sin0 3 

-sin0-jcos9 3 


sin0^sin0 2 cos0 3 

-cos0^sin0 3 

cos0 2 cos0 3 

cos0iSin0 2 cos0 3 

+sin0-jSin0 3 


sin0-jcos0 2 

-sin0 2 

COS0-|COS0 2 


^1 

^2 

^3 

^4 


sin^isin^sin 1 ^ 

i 

sin%0.jSinJ20 3 cos%e 2 
s i n%0-| cos%e 2 cos^0 3 
s i n%9 -j sin^0 2 cos%e 3 


+ COS%0^COS%0 2 COS%0 3 

+ sin%e 2 cos!50-jcos%0 3 
- sin^SgSin^e^os^e^ 
+ sin^0 3 cos%0^cos%0 2 
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(6) M = M(Y(0i), Z(0 2 ), X(0 3 )) = YZX 
Axis Rotation Sequence: 2, 3, 1 


cosG-jCos02 


M = 


sin0 2 

**sin0^cos02 


-cos0-jsin02cos02 

+sinG^sin6 3 

cosegcosa^ 

sine^sinQgCOsB^ 

+cose^sin0 3 


cosQ-jSinOgSinO^ 

+sin0-jCOS0 3 

-cosQgSinG^ 

-sin0i5in02sin0 3 

+cos0^cos0 3 


* q.j = -sinJs0-j sin^Sl’n^Qg + cos^0-j cos^cos^ 
q 2 = +sinJ50-jSini502Cos^0 3 + sin%8 3 cosJ50^cos^0 2 
q 3 = +sinJs0^cosJ502CosJ50 3 + s i s i n^cos^ 
q^ = -sinJ50^sinJ50 3 cos%02 + sinJiGgCOS^O^cos^eg 






m 


tan 


21 


Wl-rn 


21 



/ 
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(7) M * M(Y(0 1 ), X(0 2 ), Y(Q 3 )) = YXY 
Axis Rotation Sequence: 2, 1, 2 
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-sin0-jcos0 2 sine 3 

+COS0^COS0 3 

sinG^sin0 2 

sin0-jcos0 2 cos0 3 

+cos0-jsin0 3 

M = 

sin0 2 sin0 3 

cos0 2 

-sin0 2 cos0 3 


-cos0^cos0 2 sin0 3 . 
-sin0^cos0 3 

cos0-jSin0 2 

COS0-jCOS0 2 COS0 3 

-sin0-jsin0 3 


- 




= +cos^6 2 cos(i5(0i + 0 3 )) 
q 2 = +sin^0 2 cos(%(0 1 - 0 3 )) 
q 3 = +cosJs0 2 sin(Js{0^ + 0 3 )) 
q 4 = -sin^0 2 sin(%(0 1 - 0 3 ) ) 
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(8) M ■ MWe,), Z(0 2 ), Y(0 3 )) « YZY 
Axis Rotation Sequence: 2, 3, 2 


cosO^cosG^sinO^ 
+sinG-|Cos03 

sin6 2 sin0 3 

sin0^cos0 2 sin0 3 
+cos0^cos0 3 

= +cosJs9 2 cos(35(e 1 + 0 3 )) 
q 2 = +sin 3 s 02 sl * n ( J a{ 0 i - 63 )) 
q 3 = +cos%0 2 sin(35(0-| + 0 3 )) 
q 4 = +sin3s0 2 cos(3s(e 1 - 0 3 )) 


cos0^cos0 2 cos0 3 
-sin0-|Sin0 3 

M “ 1 sin0 2 cos0 3 

-sin0-jCosO 2 cos0 3 
-cosG-|Sin0 3 


-cos0^sin0 2 


cos0. 


sin0-jsin0 2 



= tan :’( §7 ) 
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(9) M = f'HZfO-j), X(0 2 ), Y (0 3 } ) = 2XY 
Axis Rotation Sequence: 3, 1, 2 


M = 


-sinO-j sine 2 sin0 3 
+cos0-|COS02 

COSO-jSinO^ir^ 

+sin0-jCOS0 3 


-cos0 2 sin0 3 


-sinG^ cosq 2 
COSO-jCOSOg 

sino 2 


sino-j sin0 2 cos0 3 
+cos0-|Sin0 3 

-cos0-jSino 2 cosG 3 

+sine^sin0 3 

coso 2 cos0 3 


^2 

^3 

^4 


-si n%6 ^ s i n^e 2 s i n%0 3 
-si si n^cos^ 

+si n^9-| si n^e 2 co s%e 3 
+sin%0-j cos%0 2 cos%e 3 


+ cos^cos^cosJ^ 
+ sin^0 2 cos%0^cos!se 3 
+ sin^0 3 cos%0^'cos%0 2 
+ sin%e 2 sin%6 3 casJse.j 
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(10) M = Y(0 g ), x(e 3 )) = ZYX 

Axis Rotation Sequence: 3, 2, 1 


M = 


cosO-jCosOg 


sin0^cosG 2 


-sinO, 


cos0^sinO 2 sin0 3 

-sinGiCosG^ 

sin6isin0 2 sin0 3 

+cos0^cos0 3 

cosGgSinGg 


q-j = +sinH0iSin^Q 2 sin^0 3 + cos^cos^G, 

,q 2 = -sin^sin^cos^ + sinJi0 3 cos*s0.. 

q 3 = +sin%9-jSin%0 3 cos3202 + si'n^cos^e. 

q^ = +sin%0-jcos%0 2 cosii0 3 - sin^sin^e. 





cos0-jSin0 2 cosG 3 

+sinO-jSin0 3 

sinG-jSin0 2 cos0 3 
• cns0^sin0 3 

cos0 2 cos0 3 

cos%8 3 
cos^9 2 . 
cos%0 3 
,005^0, 

I I 
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(11) M = 14(2(9^, X(0 2 ) s Z(0 3 }) = ZXZ 
Axis Rotation Sequence: 3, 1, 3 


N 


-sin0-jCos02Sin0 3 
• +cos0 i cosO^ 

cos0-jcos0 2 sin0 3 

+sin0^cos6 3 

sin0 2 sin0 3 


-sin0-|Cos0 2 cos0 3 
-COSO'j cos0 3 

COS0^COS0 2 COS0 3 

-sin0^sin0 3 

sin0 2 cos0 3 


sin0-|Sin02 

-cose-jSinOg 

cos0 2 


q-j = +cos%O 2 cos(%{0-| + 0 3 )) 
-q 2 = +sin!20 2 cos(%(0-| - 0 3 )) 
q 3 = +sin%0 2 sin(- , s(0 1 - 0 3 )) 
q 4 = +cos% 0 2 sin{J 2 ( 0 -j + 0 3 )) 
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(12) M = M ( Z ( 0 1 ) , Y(G 2 ), Z{0 3 5) = ZYZ 
Axis Rotation Sequence: 3, 2, 3 


H = 


cos0^cose 2 cos0 3 

-sin0-jSin0 3 

sin0icos0 2 cos0 3 

+cos0-jSin9 3 


-sin02cos0 3 


-cos0^cos02$inO 3 

“SinO-|Cos0 3 

“Sin0icos0 2 sin0 3 

+COS0-|COS0 3 

sine 2 sin0 3 


cosB-jSinOg 

sin0-|Sin02 

cose 2 


q-j = +cos%02cos(^(0-j + 0 3 )) 

'q 2 = “SinJ50 2 sin(%(e 1 - 0 3 )) 

q 3 - +sin ? s02 c os(>2(0-| - 0 3 )) 

q 4 = +cosi20 2 sin(^(0 1 + 63}) 
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APPENDIX B 

The following subroutines with a brief description their use are 
presented in this appendix. 

(1) "EULMAT" - Generates the transformation matrix from a given set of 

Euler angles and an axis rotation sequence. 

(2) "MATEUL" - Extracts the Euler angles from the given transformation 

matrix and an axis rotation sequence. 

(3) "QMAT" - Generates the transformation matrix from a given 

quaternion. 

(4) "MATQ" - Extracts the quaternion from a given transformation 

matrix. 

(5) "YPRQ" - Generates the quaternion directly from the yaw-pitch- 

roll Euler angles. 

(6) "P0SN0R" - Computes the positive-normalized quaternion from the 


given quaternion. 



NAME : 

PURPOSE : 

INPUT: 


OUTPU T : 
ALGORITHM 
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EULMAT 

Generates a 3 x 3 transformation matrix from a 
given sequence and Euler angle set. 

ISEQ - Rotation Sequence (Integer Array (3); i.e, 
1, 2, 3) 

EUL - Euler Angles in radians, in "ISEQ" 

Order; ARRAY (3) 

A - The 3x3 transformation matrix 
REFERENCE : Appendix A; Euler Sequences (1) thru (12). 


8-020 



EULER ANGLES TO THE TRANSFORMATION MATRIX 


DN No.: 1.4-8-020 

Page: 27 


■irOR.TS rULHAl , CuLHAT 

for s:E.3-rr/j.9/7 i-:.l :z^ i2z i,;*> 

SUBROUTINE LULMAT ENTRY POINT n-;u?3? 

—% tw/rc rrnr od n r r t/d or a t a 7 cr t t ji 2 vr * o l a a k -common t : r 

E XT E RN A L _R Ej fj Ef.F ’ J C E^S JuLOC}; , J:_A kLJ 

DO C3 SIN 

* DOC4 COS 

D^OS NLRR’iS. 


STORAGE ASSIGNMENT <2tOCh, TYPE, RELATIVE LOCATION, NAME) 


j JUl 

□ 301 
D v D 1 
J D OP 


ucrr?'-r 
n :: 14 2 
7 


IT'D L 
I6 2G 
3 CL 
I N JP £ 


‘f'TGEi mETTAT 5TWA~ 


L.i Ji 
l jj} 
LDuH R 
EOJD I 
TTonn R' 


TSTJnTTbT 
an oi a q i st>G 
0 DOC 3 3 B 
an - > ntj b_j 
D a c. ij 5“3 T l iTP 


"ETT-r 

C CP 1 
LCDD 
.0 r o n 


GO101 

• . l* 

0C1G3 

2* 

CC1G4 

2* 

JU1D-. 

4* 

DO 1 1 f< 

5=* 

DOJI 3 

6* 

001 1 6 

7* 

OC 1 1 7 

3* 

3012 1 

9* 


00123 
0012 5 
0 01 2*7’ 


DC 1 3o 
00137 
JCLliO__ 
001*1 1 
0014 2 
3014 3 
_D.0144_ 
Jui4 5 
0014 S 
DC147 
Jj£lW_ 
CO 151 
30152 , 


22* 
23* 
24* 
25* 
26* 
— c2$- 

23* 

29* 


SUBpOnTlNE EuLMATtTSEC , EL L , A j 
DIMENSION ISE 3 ( 2 > , E UL < .* ) , A ( 3 , 3 
DIMENSION. X(3 «3, Z) , ft t 3 ,3 > 
~D‘0~1TT K-TTT T 

00 10 1=1,3 
00 S J -1,2 

X_(I, J,K »=? .0 . 

1 F I TVL Vt j ) XTJ , J , K ) - ^ ■ j 
CONTINUE’ 

CONTINUE 

I F ( I S C C { K ) . LE . 0 ) GO TO I L C 


» 

0013 2 

13* 

COSA-COd EULCK) ) 


I- 

30131 

14* 

IFlISEUf«. ) .fC .2 ) 

GO 1 0 


•a 01.3 3 

16* 

IFU SE C »K > .2 0 .3 ) 

GO TO 


> *- f y ■ , l — \ ■ j r» 

X(2»3,K)=— SINA 
XC3,2,K)= SIN* 

XJJLi 2 ,J< ) - COSA 

R*0 TO ICG 
XI 1 , 1 ,h »- COSA 


GO TO ID G 
X 1 1 , 1 ,K I - COS A 
_X < Ij :_,K ) r-SIN t 
X 12 , 1 , K ( — SIN a” 
X(2 ,2 , K ) — COSA 


' '< : «■: 

;..*£biAL j; A.C..'*/ 


r i \)h 
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EULER ANGLES TO THE TRAMS FORf 1AT I ON MATRIX 
(CONTINUED) 



-0153 
0015 5 
jZU-1 

2H# ■ 
31* 

nc 

CONTI N JO 
UO 4.0 L=1 
,Mr3-L 

.2 




DU 1 6 1 

3 3* 


DO Zl~ 1=1 

.3 




ODUM 

34.y 


00 3,7 : 

t 3 




CC1G7 

35* 


TEMPI,'. .0 





201 7. J . . 

~f.$. 


_D0._..r,5. v.Tr.l 

*■* 

t. _ t „ _ . . 


« 


GDI? 3 

3 7v 


xrtL.c., .1 i 

H C L U - X ( K » J » 3 1 




00175 

3 3* 


IF ( L . il . 2 } 

HO 1.0 = 3 CK , J 1 


- 


201 7 7 



IT { / U s C no LD 1 . L T . 1 . ,jL - 1 .• t 

GO 

TO 253 


TC2tii. 



IF ( AE: S < M 1 

, K » “ ) 1 . L T . 1 . . E - 

i : 

) GO TO 250 


,iD2C3 

m* 


1 FMl*= T£ «P + X Cl ,K . M ) I-: i ID L ^ 


- 


00204 

4 2* 

25 L 

CONTI wU£ 




* 

302 DO 

4 


iriL.co.i ) 

a c i , j i rrt'HP 




j.0210 



T F 1 L • E L . Z 1 

Ad.JlzTcHP 




0C212 

4 5* 

300' 

CONTI NU5 





30215 

4 

4 00 

CONTINUE 





CO 21 7 

4 7* 


RE7UKN 

% 


* 


Q022 3 

4 6* 


END 





END OF COMPILATION: NO. DIAGNOSTICS. 
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NAME : MATEUL 

PURPOSE : Extracts the Euler angles from the given trans- 

formation matrix and the required Euler 
rotational sequence. 

INPUT : ISEQ - Rotation sequence, (Integer Array (3), 

i.e., 1,2,3.) 

A - The 3x3 transformation’ 

OUTPUT : EUL - The Euler angles, in "ISEQ" order- ARRAY (3 ) . 

ALGORITHM REFERENCE : Appendix A; Euler angles as a function of the 

matrix elements, sequences (1) thru (12). 



DN No.: 
Page: 


1.4-8-0P0 

30 


TRANSFORMATION MATRIX TO THE EULER ANGLES 


STOP, IS ‘•'ATtUL, MATEUL 

TOR S3c3-C2/i9/77-v'&:?^ :2S t,.l 


Su3R0u7INtl KATEUL ENTRY POINT DT3S5 


"STORx&r osrti r c ortr i r ftj rr g 3 rr ATrrrrfT f j _ z r b l a u jttokm ok 1 1 i 



EXTERNAL. REFERENCES (PLOCK, MApEl 

•3023 SORT 
3064 A TAN-2 
C?J3 NERR3S 


ASSIGNMENT (PLOCK, TYPE, PEL ATI VE LOCATION, NAME) 


'ljD0b4 TDL 
CuDUC 32L 
'-CC25 1 55L 
ogoocm Bsinfc 
ttfittnu'-' - 

260GD1 J 


LlJI 
l . j 3 3 
L J(J1 


TTTG6TT 5L~ 
22P?2;j A . L 


LJ01 CC 225 7 6-iL 
cDOD R 0CCC25 CSIGN 
ULUO l - D“Lrr~'T 
0 L 20 I 00 0012 JJ 


JCCJ l' 

r- r m -v ** 

dodo r 6 

•DroerTT 

C G 3 0 1 2 


GDI 01 
0310 3 
'OOir.T- 
30 10 5 
JO 106 
DGir-7 
JOT 1 T 
JC11 1 
DO 1 1 3 
DC114 
"00 ITT 
GDI 17 
30121 
L.012J_ 
~LTu 12 4 
GO 126 
jG 1 2 7 
6C13C. 
"30132" 
DD135 
00135 
DPI 3 6_ 
"031 a': 
2D14 i 
DC 14 2 
>.■014 4_ 
“JO 14 '3 
J014 7 


SUB RCUI1N C HA TEUL < I Sl 0 , A , rUL 1 
DIMENSION A ( 3 , 0 1 , EUl t 3 > 
"OTMENSTOTTSOrroI 
1 = I SEC <11 
J“IS£ C < ? ) 

K- ISL 0 ( 3 1 

-j'r 

IF ( I 7 E U » K ) lEOKri^Os 

BSI6N=1.6 

csic-N = i.: 

"rrriTE pttt - gtjt'to in 

IFU .£ 0.2 1 GO TO 23 
IFt J.NE . i 1 GO TO 5 

BSIC-hr-l . 

IF l It Cft.i.c .ul L ~ 

60 TO 30 
CSIGN--1 . o 
IF( IECK .*iF.D) L - 1 
TO R> TO 

IF I J. \E . 2 1 GO TO 15 
3SIGN--!.: 

IF tIECK. NE.O) L~3 

~GO“T'ti 33 
CSIGN - -1*. 2 
IFt ILCK.NE.-J1 L -Z 
GO TO 3 2 

"T rrj ."ntttttc to it 

3 S 1 0 N - “ 1 • G 


c -tjour > 

OUiJ.J.3 

c.-ncrow 
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TE TRANSFORMATION MATRIX TO THE EULER ANGLES 

(CONTINUED) 


3020"‘t 


TT j JLDK.UE.D) L - 1 

CO 7 0 3-1 

..2.5l .CSU- r,=-l.r* 

I F ( 1 1 C K * N E . D ) L = 3 
It: JO l^Z 1,3 

FMSGI, r j . j 

rosc.i«=: 

■ if t u .t i.rr^To? 

ir i u • r.c . i ) go to so 

IF UlGK.KC.GI GO TO 90 

FNSGNr^SJ r.M 

J Jr 1 • 

GO TC 9f> 

“D J Jr L : 

_7FU-SIG''. G T-D .;>) FDSGMr- 

m s r n u k - r nt. g r * a! r, j j 

F DC N r F D 5- G f, * A ( I , J J ) 

GO TO 9C 

SL- X F ( 3 1 ' K . M f . J ) GO TO :> 5 
F M S o i\ — 1 ) S 3 GN 
I T- K 
JJr K 

GO TO 6P 

~ 5 T 7 T D'ffCTTro STBTT ~ 

ir=L < 

J jrl 

60 F HU h-J NS G N* A ( J , K J 
FDCl.r FGSi'Uv ATT 1 , JJl 
GO TC 9? 

70 irt IE0K.NE.31 GO TO SC 
FNUr-.rcSIu \'*A (I,K) 

r d C iV - sc p t ( rrtr=s rxTiowrr 

GO TO 9? • 

8 U FNUMrSCiPT (l.C-Al 

FDCMr a (1,11 

“WrOl fTT)'- A T'A N'ZTFJv UK7TTJE7TT 
00 CONTINUE 
RETURN 
_ END 


END OF COMPILATION: 


DIAGNOSTICS . 



NAME ; 

PURPOSE : 

INPUT : 

OUTPUT : 

ALGORITHM 
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QMAT 

Generates the transformation matri:. from the given 
quaternion. 

Q - The quaternion; ARRAY{4). 

A - The 3x3 transformation matrix 
REFERENCE : Equation (15) from Section 2.2. 
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QUATERN I ON TO THE TRANSFORMATI O N MATRIX 

T 


lfOR,lS OHt T , 1 m A T 

TOR S' , £3-'l,;/l9/77--'5rr < i :i* !,.) 


Subroutine Ot;;.T 


ENTRY P01 NT 0 00077 


S TOR f OE U i E D : C OD ECT r~*7 3T"Tl A'TA* H7) DTTuLIT£T~'rX~A N‘K~c"0 K fi ON l 2 ) 


_L_EXT£>NAL RFFENCNCE S < aL CCK . ft A l m£ ) 
DO 03 NERR3S 


STOHASr A £ SXOT.m E N T ( o L OC*h"i T Y PIT, niTTITE*Tt r ; attctt; irfKH 


□003 000007 IMJP! 

sn^z R T oir: ij _p 6 


L-ro-i r oor-ooc P 2 

0 1.00 R CD 30 0 b TEK P 


DODO R DSDODl 


JO 101 ~ 

0010 3 
go i n *4 

30105 

1^" 
7* 
3# 
a v 

Sim'R.6 'JTffTT OTTSTTrpa 
01KEKS10K 014 ) r A 13, 3) 
P2-C l 2 ) + 0 C 2 } 

P3 = C ( 3 J -*■ v. f 3 ) 


^ d i r 6 

5^ 

P4=t,( ■» )+L (4 ) 


0D1C 7 

6=? 

P£zrP2*QC2] 


DO 110 

7* 

P6-F4 *0(4 ) 


3011 1 

n* 

T£MF=1 .0-03*0 (5 ) 


0011 z 

9* 

ACI , 1 >=TO'P-P5 


3011 3 

If* 

A(? f 2 }=} . --P5-P6 


•3Di m 

1 14 

A ( 3 » 3 } -TE NR-P 4 


001 IS 

12* 

or,rl'?*0C5 ) 


JO! 1 L 

13* 

P’£ = F 4 * C f i t 

i 

00117 

14* 

A ( 1 . l ) zp 5 — P£> 


00 12 3 

15* 

A C 2 , 1 )rFE+Po 


■3012 1 

16-7 

P 5 - P 2 * 0 ( a ) 


0012 2 

^ 7- 
x *>- 

P 6 - P 5 * 1 j ( 1 ) 


001? 3 

1 

A { 1 , 3 1 =PS + P6 


CD 12 4 

197 

A f 5 , 1 ) =ri> -P6 


jriU.5 

2f* 

P5zp 3*0(4 ) 


00126 

21* 

PS-P2*(j ( 1 ) " ~~ 


00127 

? 2* 

A ( 2 , 5 > -° £ -P'j 


DC 110 

2 37 

A(2,1J=P5+P 0 


00131 

2 4* 

RETURN 


00152 

257 

END 



£ >J D_.ftE _-C QFPI LATiQN; NO 01 AGNOSTICS. 
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NAME: 

PURPOSE: 


INPUT : 

OUTPUT : 

ALGORITHM REFERENCE: 


MATQ 

Extracts the positive quaternion from the given 
transformation matrix. 

A - The 3x3 transformation matrix 
Q - The positive quaternion;ARRAY(4). 

See Reference 2. 
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u __ TRANSFORMATION MATRIX TO THE QUATERNIO N 

■SFo&tSl hatCiMato 

FOR S‘*t3-.' , r/;9/7 7-35:24 :?l { , ", J 


SUBROUTINE MATO ENTRY POINT ZZZZ J3 

— sroT ? a g c — et rj v cwetit 5oo7T3T"D'ata i -vr^rnTJT' bLas/k- ( 2t~ 

EXTERNAL RETC RFHCES (U-OCt;.,., NAVE) i_ !_ 

■ rjc CI3 SwRT 
00 G4 NE R R3 S 


STOP A OF ASSIGNMENT (GLOCft, TYPE, PELaTIVC LO'CATjON, fcAp.F) 
OHC 1 2 G n Q 7 3 _ 1 ? L CTJl Gr^S? r.:. 7 G LDCJ 1 3 01157 

occi noTiiri 3 sl o 3 «.Ti “*o'j r :i: i i 4 'l' JCCi r.i ig- 

0030 000015 INJPS 0000 I JOflCCb J CCuu R 'OJljJi 



OOIQl 
_J 0 1 D 3 
jd 104 
001C5 
00105 
00111 
"loT tz~ 
JO 1 1 4 
0011 6 
3C12JL 
JOT? 1 

DO 12 2 
CD123 
CD 1 ?4 
joTj'r 
UC12 5 
OQ127 

J10131 

00131 

00132 

00133 
_C313 4_ 

JOT 2 6 
0013? 
DC 14 0 
JLCll 4 2_ 
JC 14 4 


SUBROUTINE MATO ( A , Cl 
DIMENSION A (3 ,3) f G(q» ,1(4 » 

i=tj 

B I G - D • 3 
00 4L J = 1 ,4 
0(J)-0 

~tt T irrtTuTTT'ir err o it 

irt J.E0.3 ) GO TO 2C 
1F{ J.EC.4 ) GO TO 30 

gij>=:.o _________ 

TEm F = ATI , :ha (TJTT+a t 2 , TT+TTS 
r ( j > = j . n 
GO TO 35 

TEMP- A t ! , 1 ) - A ( 2 * 2 ) - * (3,31+1 .0 

T'QT-rr*, r r-A t s i y— y 

GO TO 35 

TEMP-- AH ,1 ) + A(2, ">)-A (3,3 )+l. L 

_ T ( J ) - A ( 1 , 3)-A (3, 1) 

TO T O 3 5 

TEMP = -A U . 1 >-A ( 2 » ?)+A t 3 » 3 )♦! . G 


21 * 

T ( JI=M?» 1 »-A (i 

22 * 

35 TFUEVP.LT. BIG) 

,J > T 

A-.V 

TTlG-lTTMP 


I“J 

25 * 

*» G CONTINUE 


U I] ILU* J f UU I U t-j 

t ( i r= ;; f c* so p tttt t j 

IFtl.NE.l ) Ql !)=At»S.tL'. 25 oTm/ 0 (IM 


GDI 4 7 
_jG 1.5? 

2°* 

3^* 

TEMP-2.25 /0( 1 ) 
00 bd 


30153 

31* 

Ql JJ-TEMP *T(J ) 



3G154 

52* 

SC CONTINUE 


30155 

33* 

50 RETURN 

- . _ 

G0157 

34* 

END 



END OF COMPILATION: 


OT ACNOST ICS . 
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NAME : 

PURPOSE : 

INPUT : 

OUTPUT : 

ALGORITHM REFERENCE : 
sequence (10), a 3, 2, 

NOTE: This subroutine 
quaternion. 


YPRQ 

Generates the quaternion directly from the yaw- 
pitch-roll Euler angles, i.e,, a 3, 2, 1 Euler 
sequence. 

YPR - The yaw-pitch-roll Euler angles; ARRAY (3). 
QO - The positive quaternion, ARRAY (4). 

Appendix A, the quaternion equations for Euler 
1 sequence. 

calls "POSNOR" to take the normal of the positive 
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YAW-PITCH-ROLL EULER ANGLES TO THE QUATERNION 

l . - 

3 F Oft T S I YPR Q, Y^RO 

FOR s:i£3-D2/1?/7 7-S6:2h : Vi ( , M 


SUBROUTINE YP PQ ENTRY POINT D'CUK 

'5T0T^Gr"ULTfTTr 'COT)£T‘17“?r^jT:Tr"n'n^YF:.^IJUr2i;‘;”pL ANK-'cOFMOirfj 1 L 
£ J<T CoNfL HEEL ftCK CES (isL O Ch, N AME) , 


0003 POSNOR 

D □ G t! cos 

rm?c; civ 


30 06 
STORAGE 

NG ft r?s 1 
ASSIGNMENT 

C iTLOCKt TYPE. P CL ATI VtL LOCATION, NAME) 

3000 It 
0? CD p 

''CIOIS CP 

hy 

EG DM 2 SY 

COSO R On n Gll CR scon p 003007 c 

uuul 000016 INJpi JGQ3 R GjOOOO v. 

LtilOu ft 

| y 

1 



_ ICO r r 

1* 

SU t* 0 U 1 t, Y P - > C ( * PK » t* C > 

□ DID 3 

2* 

DIMENSION YPP 131 r ClH> t t.0 14l 

GOICh 

3* 

HY - . S G*Y PR ( 1 ) 

3D1D5 

“v 

HPrC . 5 ;*Y f’R l 2 J 

30 1 C 5 

b* 

HR — <..•• b ~*Y P f? t i > 

30 1 G ? 

6*- 

CY-C 0 S ( H Y > 

00113 

7* 

CP-C OS l Up ) 

SC 1 1 1 

B* 

CP - C U S ( Hit ) 

jOI 1 2 

9 <= 

5Y=STNfffr> 

C0113 

1C* 

SP-SjN(HP) 

3D114 

n* 

SR- SI N l HR ) 

*G 1 1 5 

12* 

Of I ) -CY*C r*CP*SY*SP*3R 

00116 

13* 

0(2) =C Y*CPvSR-SY*5P*Cr? 

00117 

let* 

01 3 J -C Y*S P*CR +SY*CF*S A 

GO 12 3 

15* 

01 4 ) r-CY* SP*S n +SY*C^*CP. 

i. 00131 

16* 

CALL P 0 S N C R ( 0 ,00 ) 

00122 

1?* 

Re TURN- 

0012 3 

IS* 

END 

- ; E>7D 

OF COt-iP I CAT TON: NO DT7TG NO STIC ST 


REPRODUCIBILITY OF THE 
’ ORIGINAL PAGE 18 POOR 
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NAME: POSNOR 

PURPOSE : To output the positive and normalized quaternion 

from the given quaternion. 

INPUT : Q - The quaternion; ARRAY (4). 

OUTPUT : QO - The positive-normalized quaternion; 

ARRAY (4).. 

ALGORITHM REFERENCE : 

1. If the sign of Q(l) is negative: 

Set QO ( I ) = — Q ( I ) for 1=1,2, 3, 4. 

2. Set QO ( 3 ) = QO ( I ) /TEMP 

Where TEMP = VqO^ + QO* + Q0| + QOj 


-020 
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STOftAtiF A S S I C. NM ENT (BLOCK, TYPE, PELATIVL LOCATION, K A ft E ) 


3301 r^ n r>i bj. i ic 

coco ir^ircrj i ■£>"?* 


c-jci jc;:-a ;6 igig 



0 Din; 
03 154 

2 $ 
3# 

SUrPCUTTIjF POSNOR to ,£,‘0) 
DIMENSION G14 1,0014 1 
TFNF-1 . 7 


CD ICS 

4$ 

' I F ( L i 1 } . l I # D * j lTFf pF=Trc 

- - 

00137 

5c 

SU«=L.J 


JO 1 1 0 

&c 

DO '51 1-1,4 


0011 3 

7 c 

00(1 ) -TGMPctM I) 

. . , 

00114 


SUN =Su!i+ u 0 1 1 ) CL tTtTl \ 

¥ 

00115 


50 CONTI MIF 


001 1 7 

10c 

TFMP=1 . 0/ SORT (SUM ) 


00123 

1 

DO IlO 1=1,4 


CD 123 

12c 

(TO f 1 1 -TtH r *00 n y 


GO 12 4 

1DC 

10 D CONTI NUT 


■;o 1 2 b 

14* 

RE TUftJ-J 


roiz 7 

15C 

END 


END OF COhP IL A T I ON 


NO DIAGNOSTICS 




